//
//  robot.c
//  Embedded_System
//
//  Created by Edward Bassan on 3/5/14.
//  Copyright (c) 2014 Edward Bassan. All rights reserved.
//

#include "robot.h"
#include <stdio.h>
#include <stdlib.h>
#include "global.h"
#include <math.h>
#include <wiringPi.h>
#include <time.h>
#include <unistd.h>
#include <softPwm.h>



/*
 The main
 */
int main (int argc, char** argv) {
    
    //Setup for the wiringPi
    if(wiringPiSetup() == -1){
        printf("Fail to setup wiringPi \n");
        exit(1);
    }
    
    SensorPtr sensor = newSensorConstructor();
    sensor->ping(sensor, 2);
    
    
    
    return 0;
}
